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@ Verfahren und Vorrichtung urn die Genauigkeit von Positionsabschatzungen in einem satellitengestutzten 
Navigationssystem zu verbessern 

(g) Die Genauigkeit einer Positionsabscbatzung, die unter 

Benutzung eines satellitengestutzten Navigationssystems 

erzeugt wird, wird verbessert, indem man fur nicht lineare 

Fehler in den Fahrzeugpositiohsberechnungen Rechnung 

tragi Die Standardnavigattonsgleichung wird modifiziert, 

um Fehlerkoeffizienten a, 0, y und 8 einzuschlie&en. a wird 

benutzt, um Fehler in der x-Dimension zu modulieren. p wird 

benutzt, um Fehler in der y-Dimension zu modulieren. y wird 

benutzt, um Fehler in der z-Dimension zu modulieren. 8 wird 

benutzt, um Fehler in den Pseudoabstanden zu modulieren. 

Die Fehlerkoeffizienten konnen berechnet werden unter 

Benutzung eines GPS- Systems mit offenem Ende oder eines 

GPS-differentiellen G PS-Systems. Die Fehlerkoeffizienten 

konnen in der reellen Zelt berechnet werden und fur eine 

Periode danach benutzt werden. Einmal berechnet, konnen 
" die Fehlerkoeffizienten als Faktoren in die Berechnung einer 
f Fahrzeugpositionsabschatzung fur gesteigerte Prazision ein- 
* gehen. 
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Beschreibung 



Gebiet der Erfindung 

Die Erfindung bezieht sich allgemein auf das Gebiet der Navigationssysteme, die eine Konstellation erdum- 
kreisender Satelliten benutzen, um die Position eines Empfangers auf oder in der Nahe der Erdoberflache zu 
bestimmen. Genauer bezieht sich die Erfindung auf ein Verfahren und eine Vorrichtung, um die Genauigkeit von 
Positionsabschatzungen in solch einem Satellitengestiitzten Navigationssystem zu verbessern. 

10 

Hintergrund der Erfindung 

Einige nationale Regierungen einschlieBiich der Vereinigten Staaten (U.S.) von Amerika entwickeln gegen- 
wartig ein irdisches oder terrestrisches Positionsbestimmungssystem, auf das generisch als ein globales Positio- 
15 nierungssystem (GPS) Bezug genommen wird. Ein GPS ist ein satellitengestutztes Radionavigationssystem, mit 
dem man beabsichtigt, hochgenaue dreidimensionale Positionsinformation an Empfanger auf oder in deir Nahe 
der Erdoberflache zu liefern. 

Die US-Regierung hat ihr GPS mit "NAVSTAR" bezeichnet. Man erwartet, daB das NAVSTAR GPS fUr 
v&llig betriebsbereit von der US-Regierung im Jahre 1993 erkiart wird. Die Regierung der ehemaligen Union der 
20 Sowjetischen Sozialistischen Republik (U.S.S.R) ist mit der Entwicklung eines GPS, das unter dem Namen 
"GLONASS" bekannt ist, beschaftigt Des weiteren sind zwei europaische Systeme bekannt als "NAVSAT und 
"GRANAS" ebenso in der Entwicklung. Um die Diskussion zu vereinfachen, konzentriert sich die folgende 
Offenbarung speziell auf das NAVSTAR GPS. Jedoch hat die Erfindung gleiche Anwendbarkeit auf andere 
globale Positionierungssysteme. 
25 In dem NAVSTAR GPS sieht man vor, daB vier umkreisende GPS-Satelliten in jedem von sechs getrennten 
kreisfdrmigen Orbits existieren, um eine Gesamtsumme von 24 GPS-Satelliten zu ergeben. Von diesen werden 
einundzwanzig betriebsbereit sein und drei werden zur Reserve dienen. Die Satellitenbahnen oder -orbits 
werden weder polar noch Equatorial sein, sondern werden in gegenseitig orthogonal geneigten Ebenen liegen. 
Jeder GPS-Satellit wird die Erde ungefahr einmal alle 12 Stunden umkreisen. Dies zusammen mit der 
30 Tatsache, daB die Erde einmal alle 24 Stunden um ihre eigene Achse rotiert, bewirkt, daB jeder Satellit genau 
zwei Orbits vollendet, wahrend die Erde eine Umdrehung macht. 

Die Position jedes Satelliten zu jeder gegebenen Zeh wird prazise bekannt sein und kontinuierlich an die Erde 
gesendet werden. Diese Positionsinformation, die die Position des Satelliten im Raum beztiglich der Zeit 
(GPS-Zeit) anzeigt, ist als ephemerische Daten oder Information bekannt 
35 Zusatzlich zu den ephemerischen Daten schlieBt das Navigationssignal, das von jedem Satelliten gesendet 
wird, eine prazise Zeit ein, zu der das Signal gesendet wurde. Der Abstand oder die Reichweite von einem 
Empfanger zu jedem Satelliten kann bestimmt werden durch den Gebrauch dieser Obertragungs- oder Sende- 
zeit, die in jedem Navigationssignal eingeschlossen ist. Indem man den Zeitpunkt notiert, an dem das Signal am 
Empfanger empfangen wurde, kann eine Ausbreitungszeitverzogerung berechnet werden. Diese Zeitverzflge- 
40 rung, wenn sie mit der Ausbreitungsgeschwindigkeit des Signals multipliziert wird, wird einen "Pseudoabstand" 
von dem sendenden des Satelliten zum Empfanger ergeben* 

Der Abstand wird "Pseusdoabstand" genannt, weil die Empfangeruhr nicht prazise mit der GPS-Zeit synchro- 
nisiert sein kann und weil die Ausbreitung durch die Atmosphare Verzogerungen in den Navigationssignalaus- 
breitungszeiten einfuhrt Diese haben einen Uhrenfehler bzw. einen atmospharischen Fehler oder in eine 
45 Richtung gerichtete Abweichung zur Folge. Uhrenfehler konnen bis zu einigen Millisekunden betragen. 

Indem man diese zwei Teile von Informationen benutzt (die ephemerischen Daten und den Pseudoabstand) 
von mindestens drei Satelliten, kann die Position eines Empfangers in Bezug auf den Erdmittelpunkt unter 
Benutzung von passiver Triangulierungstechniken bestimmt werden. 

Die Triangulierung schlieBt drei Schritte ein. Zuerst muB die Position von mindestens drei Satelliten im "Blick" 
50 des Empfangers bestimmt werden. Zweitens muB der Abstand von dem Empfanger zu jedem Satelliten bestimmt 
werden. SchlieBlich wird die Information der ersten beiden Schritte dazu benutzt, um geometrisch die Position 
des Empfangers in Bezug auf den Erdmittelpunkt zu bestimmen. 

Die Triangulierung unter Benutzung von mindestens drei der erdumkreisenden GPS-Satelliten erlaubt die 
absolute terrestrische Position (Langengrad, Breitengrad und H6he in Bezug auf den Erdmittelpunkt) von jedem 
55 beliebigen Erdempfanger mit einer einfachen geometrischen Theorie zu berechnen. Die Genauigkeit der Posi- 
tionsabschatzung hangt teilweise von der Anzahl der umkreisenden GPS-Satelliten ab, die aufgenommen 
werden. Indem man mehr GPS-Satelliten bei der Berechnung benutzt, kann man die Genauigkeit der terrestri- 
schen Positionsabschatzung erhdhen. 
Gew6hnlich werden vier GPS-Satelliten aufgenommen oder abgetastet, um jede terrestrische Positionsab- 
60 schatzung zu bestimmen. Drei der Satelliten werden ftir die Triangulierung benutzt und ein vierter wird 
hinzugeftigt, um fiir den oben beschriebenen Uhrenfehler zu korrigieren. Falls die Empfangeruhr prazise mit der 
der GPS-Satelliten synch ronisiert ware, dann ware dieser vierte Satellit nicht notwendig. Jedoch sind prazise 
(zum Beispiel Atom-) Uhren teuer und sind deshalb nicht fiir eine Anwendung geeignet 

Ftir eine detailliertere Diskussion Ober das NAVSTAR GPS, siehe Parkison, Bradfort W. und Gilbert, Stephen 
65 W. ( "NAVSTAR: Global Positioning System - Ten years later,* Proceedings of the IEEE, Band 71, Nr. 10, 
Oktober 1983 und GPS: A Guide to the Next Utility, veroffentlicht von Trimble Navigation Ltd., Sunnyvale 
Kalifornien, 1989, Seiten 1—47, von denen beide hier durch die Bezugnahme aufgenommen sind. Fiir eine 
detaillierte Diskussion eines Fahrzeugpositionierungs/Navigationssystem, das das NAV-STAR GPS benutzt, 
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siehe das in gemeinsam^fcsitz befindliche U.S. Pat. Appl. Ser. No. 07/628,560^^em Titel 'Vehicle Position 
Determination System anTMethod", eingereicht am 3. Dezember 1990, das hier durch die Bezugnahme aufge- 
nommen wurde. 

In dem NAVSTAR GPS werden elekromagnetische Signale von jedem Satelliten kontinuierlich unter Ge- 
brauch emer einzigen Tragerfrequenz gesendet bzw. transmittiert Jedoch benutzt jeder Sateilit einen verschie- 
denen Modulationsgoldcode, um eine Differentierung der Signale zu erlauben. Die Tragerfrequenz wird modu- 
liert durch den Gebrauch eines pseudozufalligen Signals, das fur jeden GPS-Satelliten einzigartig ist. Folglich 
konnen die umkreisenden GPS-Satelliten identifiziert werden, wenn die Navigationssignale demoduliert wer- 
den. 

AuBerdem sieht das NAVSTAR GPS zwei Moden oder Betriebsarten der Modultion der Tragerwelle vor, 
unter Benutzung von pseudozufalligen Signalea In dem ersten Mode wird der Trager von einem "C/A-SignaP 
geandert und moduiiert und auf ihn wird als "Grob/Acquirierungsmode" Bezug genommen. Der Grob/Acquirie- 
rungs- oder C/A-Mode ist auch bekannt als "Standardpositionierungsdienst". Das C/A-Signal ist eine Goldcode- 
sequenz die eine Impulsrate von 1,023 MHz besitzt. Goldcodesequenzen sind in der Technik bekannt 

Ein Impuls ist ein individueller Puis eines pseudozufalligen Codes. Die Impulsrate einer pseudozufalligen 
Codesequenz ist die Rate, mit der die Impulse in der Sequenz erzeugt werden. Folglich ist die Impulsrate gleich 
der Codewiederholungsrate geteilt durch die Anzahl der Glieder in dem Code. Mit Bezug auf den C/A-Mode des 
NAVSTAR GPS existieren 1023 Impulse in jeder Goldcodesequenz und die Sequenz wird einmal alle Millise- 
kunden wiederholt Im Gebrauch der 1,023 MHz Goldcodesequenz von vier umkreisenden GPS-Satelliten 
ermdglicht die terrestrische Position eines Erdempfangers mit einer ungefahren Genauigkeit innerhalb von 60 
bis 1 00 m zu bestimmen (mit 95% Sicherheit). 

Auf dem zweiten Modulationsmode in dem NAVSTAR GPS wird allgemein als der "prazise" oder "geschtitz- 
te w (P fur precise oder protected) Mode Bezug genommen. In dem P-Mode hat der pseudozufallige Code eine 
Impulsrate von 10,23 MHz. AuBerdem sind die P-Modesequenzen extrem lang, so daB die Sequenzen sich nicht 
mehr als einmal alle 267 Tage wiederholen. Im Ergebnis kann die terrestrische Position eines beliebigen 
Erdempfangers innerhalb einer ungefahren Genauigkeit von 16 Metern bestimmt werden (spharischer Irrtum 
oder Fehler wahrscheinlich). Der P-Mode ist ebenfalls als der "prazise Positionierungsdienst" bekannt 

Die P-Modesequenzen werden von der Regierung der Vereinigten Staaten geheimgehalten und nicht dffent- 
Iich zuganghch gemacht Der P-Mode ist nur fur die Benutzung von Erdempfangern vorgesehen, die speziell von 
der Regierung der Vereinigten Staaten autorisiert wurden. So sind die P-moduIierten Daten nicht allgemein 
zuganghch, so daB viele GPS-Benutzer sich alleine auf die GPS-Daten verlassen mussen, die tiber den C/A-Mo- 
dulationsmode geiiefert werden. Dies bedeutet fur viele Anwender ein weniger genaues Positionierungssystem. 

Die oben diskutierten Uhren und atmospharischen Fehler kommen zu der Ungenauigkeit des Positionierungs- 
systems hinzu. Andere Fehler, die die GPS-Positionsberechnungen beeinflussen, schlieBen Empfangerrauschen 
Signalreflektion, Abschattungseffekte und Satellitenpfadyerschiebungen (zum Beispiel Satellitenwackeln) ein* 
Diese Fehler haben eine Berechnung von fehlerhaften Pseudoabstanden und eine von fehlerhaften Satellitenpo- 
sitionen zur Folge. Fehlerhafte Pseudoabstande und fehlerhafte SateUitenpositionen fuhren ihrerseits zu einer 
Vernngerung in der Prazision von Positionsabschatzungen, die von einem Fahrzeugpositioniersystem berechnet 
werden. 

Es sind Verfahren verfugbar, um viele dieser Fehler zu kompensieren oder zu verbessern. Jedoch haben 
atmospharische Fehler und Satellitenpfadyerschiebungen nicht-lineare Komponenten. Diese Fehler bedeuten 
eine ± 2 Meter Beschrankung auf die Positionierungsprazision. 

Eine konventionelle Methode, die diese nicht-linearen Fehler zu kompensieren versucht, benutzt ein differen- 
tielles System (diskutiert weiter unten), um einen linearen Fehler fur jeden Pseudoabstand (d. h. ein Fehler wird 
Fur jeden Satelliten berechnet) zu produzieren. Eine Basisstation, die eine feste, bekannte Position besitzt 
berechnet einen Pseudoabstand fur jeden Satelliten. Die Basisstation berechnet weiter einen Abstand oder eine 
Distanz zwischen ihrer bekanhten Position und der Position jedes Satelliten (die aus den empherischen Daten 
berechnet wird). Indem man den Pseudoabstand mit jedem berechneten Abstand vergleicht, kann ein Pseudoab- 
standfehier fur jeden Satelliten berechnet werden. Der Pseudoabstandsfehler fur jeden Satelliten kann dann an 
das Fahrzeug gesendet werden zum Gebrauch fur die Positionsabschatzungsberechnungea 

Jedoch berOcksichtigt dieses Verfahren nicht die nichtlineare Natur dieser Fehler. Zum Beispiel wenn die 
ephemenschen Daten anzeigen, daB der Sateilit an einer Position P, ist, und der Sateilit tatsachlich an einer 
Position P 2 ist, (zum Beispiel auf Grund eines Wackeins), dann kann eine einzelne lineare Abweichung oder ein 
henler, der dem Pseudoabstand verahdert, nicht das Wackeln vollstandig korrigieren 

Demzufolge wird ein Verfahren benotigt, das fur diese nicht-linearen Fehler korrigiert, so daB die Prazision 
der Fanrzeugpositionsabschatzungen verbessert werden kann. 

Zusammenfassungder Erfindung 

. Die Erfindung ist eine Vorrichtung und ein Verfahren zum Gebrauch mit einem satellitengesttttzten Naviga- 
tionssystem. Die Genauigkeit von Fanrzeugpositionsabschatzungen wird verbessert, indem man die nicht-linea- 
ren Fehler m den Fahrzeugpositionsberechnungen beriicksichtigt. Die Standardnavigationsgleichung wird mo- 
difiziert, um die Feh lerkoeffizienten a, p, y und 8 einzuschlieBen. a wird dazu benutzt, um Fehler in der 
x-Dimension zu modell.eren. p wird benutzt, um die Fehler in der y-Dimension zu modulieren. y wird benutzt, um 
■fumldSi^ 2 " DimenS,0n ZU modeI1,eren ' 5 wird ^nutzt, um einen mittleren Fehler in den Pseudoabstanden. 

( K iC modeI,i ^ rt .r rd J e . ri mit Gebrauch v on a, p, y, 5) in ihrer Natur zufallig sind, wird 
jede Null als Mittelwert besitzen und Ober .die Zeit unvorhersagbar sein. Jedoch uber eine kurze Periode 
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erwartet man, daB die F oeffizienten Trends folgen, die charakterisiert .we iese Trends werden von 

den Fehlerkoeffizienten modelliert Im wesentlichen ubertragen die Fehlerkoeffizienten den Fehler von jedem 
Satelliten in der Konstellation in einen Fehler in der Fahrzeugposition. Zum Beispiel werden die Fehler in der 
x-Richtung fQr jeden Satelliten zusammen gemittelt und werden als ein einzelner Fehler in der x-Richtung der 

5 Fahrzeugposition reprSsentiert So besitzen die Fehlerkoeffizienten nur eine Bedeutung in einer besonderen 
Konstellation (zum Beispiel vier ausgewahlte Satelliten), far die sie ausgerechnet wurden. 

Die Erfindung kann entweder mit einem GPS-System mit offenem Ende oder einem differentiellen GPS-Sy- 
stem benutzt werden. In einem ersten Ausfiihrungsbeispiel eines GPS-Systems mit offenem Ende werden acht 
Satelliten benutzt, urn Werte fur die Fahrzeugposition zu berechnen, einen Uhrenfehlemnd die vier Fehlerkoef- 

to fizienten. In einem zweiten AusfQhrungsbeispiel des GPS-Systems mit offenem Ende werden sechs Satelliten 
benutzt, um Werte fiir die Fahrzeugposition, einen Uhrenfehler und die vier Fehlerkoeffizienten zu berechnen. 
In einem dritten Ausfiihrungsbeispiel des GPS-Systems mit offenem Ende werden vier Satelliten benutzt, um 
Werte filr die Fahrzeugposition, einen Uhrenfehler und die vier Fehlerkoeffizienten zu berechnen. 

In einem AusfQhrungsbeispiel des differentiellen GPS-Systems werden fiinf Satelliten im Zusammenhang mit 

15 einer Basisstation benutzt, um Werte fiir den Uhrenfehler und die vier Fehlerkoffizienten zu berechnen. Die 
Fehlerkoeffizienten kdnnen dann an das Fahrzeug gesendet werden, um fur die Fahrzeugpositionsberechnung 
benutzt zu werden. 

Die Fehlerkoeffizienten kdnnen in Verbindung mit der Berechnung der von jeder Fahrzeugpositionsabschat- 
zung (d h. in der Realzeit) berechnet werden. Alternativ konnen die Fehlerkoeffizienten einmal berechnet 
20 werden und in den Fahrzeugpositionsberechnungen ftir eine Zeitperiode danach benutzt werden. Abhangig von 
der speziellen Methode, die benutzt wird, um die Fehlerkoeffizienten zu berechnen, wird angenommen, daB die 
Werte der Fehlerkoeffizienten benutzt werden kdnnen und die Genauigkeit von Fahrzeugpositionsabschatzun- 
gen filr eine Zeitdauer im Bereich von einigen Minuten bis zu einer so langen Zeitperiode, wie die ausgewahlte 
Konstellation der Satelliten im Blick bleibt, benutzt werden konnen. 
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Kurze Beschreibung der Zeichnungen 



Fig. 1 ist ein Diagramm, das die NAVSTAR GPS-Satelliten in ihren jeweiligen Orbits um die Erde zeigt; 
Fig. 2 ist ein Diagramm, das ein autonomes Fahrzeugsystem darstellt, das eine Konstellation von vierGPS-Sa- 
30 telliten, ein Pseudolite, eine Basistation und ein autonomes Fahrzeug einschlieBt; 

Fig. 3 ist ein Blockdiagramm des autonomen Fahrzeugsystems, das das Fahrzeugpositionierungssystem des 
autonomen Fahrzeugs im Detail darstellt; 
Fig. 4 ist ein Blockdiagramm eines GPS-Verarbeitungssystems; 

Fig. 5 ist ein Diagramm, das die geometrische Beziehung zwischen dem Erdmittelpunkt, einem Fahrzeug in 
35 der Nahe der ErdoberflSche und einer Konstellation von GPS-Satelliten zeigt; 

Fig. 6 ist ein FluBdiagramm, das die Schritte der Berechnung einer besten Positionsabschatzung fQr ein 
Fahrzeug darstellt; 

Fig. 7 ist ein FluBdiagramm, das eine erste Methode gemaB der Erfindung darstellt, um eine prazise Positions- 
abschatzung unter Benutzung eines GPS-Systems mit offenem Ende zu berechnen; 
40 Fig. 8 ist ein FluBdiagramm, das eine zweite Methode gemaB der Erfindung darstejlt, um eine prazise Posi- 
tionsabschatzung unter Benutzung eines GPS-Systems mit offenem Ende zu berechnen; und 

Fig. 9 ist ein FluBdiagramm, das ein erfindungsgemaBes Verfahren darstellt, um eine prazise Positionsabschat- 
zung unter Benutzung eines differentiellen GPS-Systems zu berechnen. 

45 Beschreibung des bevorzugten AusfQhrungsbeispiels * 

Die vorliegende Erfindung wird nun unter Bezugnahme auf die Figuren beschrieben, wobei gleiche Bezugszei- 
chen, gleiche Elemente/Schritte bezeichnen. 

Die Erfindung ist ein Verfahren und eine Vorrichtung, um die Richtigkeit (Integritat) der Positionsdaten, die 
50 von einem satelliterigestiitzten Navigationssystem empfangen werden, zu uberwachen. In dem bevorzugten 
AusfQhrungsbeispiel, wird das NAVSTAR globale Positionierungssystem (GPS) benutzt. Wie oben diskutiert 
wurde und wie in Fig. 1 dargestellt ist, schlieBt das NAVSTAR GPS einundzwanzig betriebsbereite Satelliten 
102 ein, die die Erde in sechs Orbits 104 umkreisen. 

Die Erfindung wird beschrieben in der Umgebung eines autonomen Fahrzeugssystems 200, wie in Fig. 2 
55 dargestellt ist. Eine reprasentative GPS-Konstellation 202 schlieBt vier GPS-Satelliten 102(a)— 102(d) ein, um 
GPS-Dateri zu Qbertagen. Ein Fahrzeug (zum Beispiel ein autonomer Lastwagen) 210 und eine Basisstation 220 
sind geeignet, um die GPS-Daten/Navigationssignale von jedem GPS-Satelliten 102 in der Konstellation zu 
empfangen mit Gebrauch der jeweiligen GPS- Antennen 212 und 222. 

Ein GPS-Empfanger kann GPS-Navigationssignale von einem Satelliten empfangen, der sich "in Blick" des 
60 Empfangers (d. h. Sichtlinienkommunikation) befindet Zum Beispiel "im Blick" kann definiert werden, als daB 
irgendein Satellit sich mindestens 1 0° uber den Horizont befindeL Der 1 0-Gradwinkel sorgt fiir eine Pufferzone 
zwischen einem nOtzlichen im Blick befindlichen Satelliten und einem Satelliten, der gerade aus dem Blick unter 
dem Horizont verschwindet 

Eine "Konstellation" ist eine Gruppe von Satelliten, die von den Satelliten im Blick eines GPS-Empfangers 
65 ausgewahlt wird. Zum Beispiel kdnnen vier Satelliten aus einer Gruppe von sechs im Blick eines GPS-Empfan- 
gers befindlichen Satelliten ausgewahlt werden. Die vier Satelliten werden normalerweise auf Grund einer 
gtlnstigen Geometrie f Or die Trianqulierung (wie unten diskutiert wird) ausgewahlt. 

Die Basisstation 220 schlieBt einen GPS-Empfanger ein (d. h. einen Referenzempfanger, der sich an einer 
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kmSSS in Verbindu i !!^ e^nde, ' °' K BasisStati ° n 220 Steht mit dem Fahrzeug uber den Kommunikations- 

„„?n!l K c m i nUnika oL 0 rt nS T ka ' ial 225 re P rasentiert die Kommunikationsverbindung zwischen der Basisstation 220 
'£5£m ?■ £ V n Cm 5"?™*" Ausfuhrungsbeispiel umfaBt der Kommunikationskanal 225 Radio- 
Fahrzeu^ ^Wzu^tm^n ^ hmmt ' U ™ ° aten Zwischen der B Station 220 und dem 

Das System 200 kann optional eine oder mehrere Pseudolites 230 einschlieBen. Ein "Pseudolite" ist ein 
sendendes System, das sich auf oder m der Nahe der Erdoberflache befindet, das einen GPS-Sate!Iiten nachahmt 
™ 5!" P se «doht e,ne feste, bekannte Position besitzt, kann es in groBem MaBe die Positionsabschatzungen, die 
inon abge,e,tet werden verbessern. Urn die Diskussion hier zu vereinfachen, wird nur auf GPS-Satelliten 
102 Bezug genommen. Es sol te jedoch verstanden werden, daB, wo Positionsdaten von einem Satelliten erfor- 
derlich smd, sie durch Daten eines Pseudolites ersetzt werden konnen. 

t^ini 8 ; 3 .^' 8 ^ *?* einC ^« h n n ? ben ? ein Blockdia g ramm d « Systems 200 der Erfindung, einschlieBlich GPS-Sa- 
Si SH? . Ba f ls . sta v V on . 22 ? und Pseudolites 230, das Fahrzeug 210 schlieBt ein Fahrzeugpositib- 

nierungssystem(VPS)310 und em Navigationssystem 320 ein. 

Das Fahrzeugpositioniersystem (VPS) 310 

Die Aufgabe, das Fahrzeug 210 entlang eines vorgeschriebenen Pfades zu ffihren, macht unter anderem eine 
genaue Positionsabschatzung der aktuellen Position des Fahrzeugs relativ zu einen Referenzpunkt erforderlich 
■1st einmal die aktuelle Position bekannt, kann man dem Fahrzeug 310 befehlen, zu seinem nachsten Bestim- 
p a hrf«lc^n r Best ' mmun esnchtung fortzufahren. Das VPS 310 erlaubt, daB Positionsabschatzungen des 
Fahrzeugs 210 mitextremerGenauigkeitbestimmt werden. 

pi„ D nlSv Chli u B l ein GPS-Verarbeitungssystem 312 und ein Bewegungspositionierungssystem (MPS) 314 
X' GPS-Verarbe.tungssystem 312 empfangt GPS-Daten, d. h. Navigationssignale von den GPS-Satelliten 
fi un p d berecb f * eine er f u e Posittonsabschatzung (FPE) fiir das Fahrzeug 210 daraus. Das MPS 314 schlieBt 
emen Fahrzeugk,lometerzahler 316 und eine Tragheitsreferenzeinheit (IRU) 318 ein, die die Position des Fahr- 
S J- f ft n u a r u 2 d ag ? VOn Veranderun S vo " emer anfangs bekannten Positioa Das MPS 314 produ- 
ce!. & * ats . a 5 t hl,che ? Berechnungen werden in dem VPS-Verarbeitungssystem 324 gemacht) eine zweite 
Positionsabschatzung fur das Fahrzeug 210. Die erste Positionsabschatzung und die zweite Positionsabschat 
zung werden unabhangig voneinander abgeleitet. rosmonsaDscnat 
Posi * ionsa ^chatzung (vom GPS) kann als eine unabhangige Anzeige der Position des Fahrzeugs 
210 benutzt werden. Ahnhch kann die zweite Positionsabschatzung (vom MPS) als eine unabhangige Anzeige 
£2 T2Z d > P ah ff. eugs 2 10 u . ben ^< ; "erden. Jedoch werden in dem bevorzugten AusfflhrungSspS die 
erste und zweite Positionsabschatzung kombiniert durch das VPS-Verarbeitungssystem 324 (wie unten disku- 
tiert wird), urn eine genauere dritte oder beste Positionsabschatzung zu produzieren 

Das Navigationssystem 320 

Das Navigationssystem 320 empfangt die dritte Positionsabschatzung von VPS 314. Das Navigationssystem 
320 benutzt diese prazise, dritte Positionsabschatzung. urn das Fahrzeug 210 genau zu navigieren Y 

GPS-Verarbeitungssystem 312 : 

Das GPS-Verarbeitungssystem 312 ist das Herz des'Systems 200. Mit Bezug auf Fig. 4 schlieBt das GPS-Ver 
arbe.tungssystem 312 ein EmpfMngersystem 400 und ein GPS-Prozessor 408 eia Das ETpftogereSten. 400 
empfang, und decod.ert die Navigationssignale von den Satelliten. Der GPS-Prozessor W SSSdS,^! 
Information vom Empfangersystem 400, urn eine erste Positionsabschatzung zu berechnen 

Das Empfangersystem 400 schlieBt eine GPS-Antenne 402, einen Vorverstarker 404 und einen GPS-Enrnfan 
ger 406 em. D,e Antenne 402 ist geeignet, elektromagnetische Strahlung in dem Ra^obereich des SpektruSsTu 
eSmGPS Sateutn SSfa" ** ^^^^S-Navigationssignal, das von einer GptXntenne 40™on 
einem OPS-SateUiten empfangen wurde. Der GPS-Empfanger 406 ist ein Vielkanalempfanger der die GPS-Na 
v.gat.onssignaledecod.ert und einen Pseudoabstand und eine Satellitenposition fur jeden SewaSten Sa S" 
ten produziert Der GPS^rozesspr 408 benutzt die Pseudoabstande und^atelliteJposition S^S^SS v?„* 
Satelhten, urn eine erste Positionsabschatzung fur das Fahrzeug 210 zu berechnen. 

Pinh dem bev ? r?u £f n Ausfilhrungsbeispiel sind die Antenne 402 und der Vorverstarker 404 in einer einzieen 
Bet _EmpBnger«» berechnet einen Pseudoabstand flin jeden Satelliten wie folgt. Wleoben beschrieben wird 
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Geschwindigkeit, der sicWBreitetenden Signale andert (was einen atmospharisMPFehler verursacht). 

Der GPS-Empfanger 40CTcann einen Almanach benutzen, urn grob die Positionaes Satellitens (zum Beispiel 
fur Acquivierungszwecke) zu bestimmen. Fflr eine prazisere Bestimmung der Satellitenposition decodiert der 
Empfanger das GPS-Navigationssignal und zieht daraus ephemerische Daten. Die ephemerischen Daten zeigen 
5 die prazise Position des sendenden Sateliiten an. 

Der GPS-Prozessor 408 berechnet die erste Positionsabschatzung unter Benutzen der Pseudoabstande und 
der Satellitenpositionen von dem GPS-Empfanger 406. Dies ist unten beschrieben in Bezug auf Fig. 5. 

Fig. 5 zeigt eine beispielhafte Satellitenkonstellation 202, die die GPS-Satelliten 102(a)— 102(d) umfaBt, im 
Blick des Fahrzeugs 210. In kartesischen Koordinkten in Bezug auf den Erdmittelpunkt, befindet sich der Satellit 
10 102(a) an der Stelle (xj, y t, zi); der Satellit 102(b) an der Stelle (x2, y2» Z2); der Satellit 102(c) an der Stelle (X3, y3 Z3); 
der Satellit 102(d) an der Stelle (X4, y4, 24); und das Fahrzeug 210 befindet sich der Stelle (U x , U y , Uz> 

Die kartesischen Koordinaten (x, y, z) von jedem Sateliiten 102 werden von dem GPS-Empfanger 406 
bestimmt unter Benutzung der ephemerischen Daten des Satellitea Die Pseudoabstande (PSRi, PSR2, PSR3 und 
PSR4) zwischen dem Fahrzeug 210 und jedem Sateliiten werden von dem GPS-Empfanger 406 bestimmt, indem 
15 Obertragungszeitverzdgerung benutzt werden. Ist diese Information fur mindestens vier Sateliiten gegeben, 
kann der Ort des Fahrzeugs 210 (d. h. des Empfangers 406) bestimmt werden unter Benutzen der folgenden vier 
Abstandsgleichungen : 
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. wobei: Bdock Buhr — Uhrenfehler. 

Der "Uhrenfehler" ist ein Korrekturfaktor nullter Ordnung, mit dem man versucht, fOr den oben diskutierten 
Uhrenfehlerzu kompensieren. 
30 Man beachtet, daB es vier Unbekannte in diesen Gleichungen gibt: U x , U y , U 2 und Buhr- Man beachte ebenfalls, 
daQ jeder Satellit eine Gleichung produziert. So haben wir vier Sateliiten und vier Unbekannte, was erlaubt, daB 
die Gleichungen nach dem Uhrenfehler (Buhr) und der Position (U x , U y , U z ) das Fahrzeug 210 aufgeldst werden. 

Wenn der Uhrenfehler (Buhr) eliminiert ist, dann bleiben nur drei Variablen in der Gleichung, so daB nur drei 
Sateliiten notwendig sind, um nach der Position des Fahrzeugs 210 aufzulosen. Der Uhrenfehler kann eliminiert 
35 werden, wenn eine Hochprazisionsuhr (zum Beispiel eine Atomuhr) in dem Empfangersystem 400 benutzt wird. 
Falls der Breitengrad (L) und der Langengrad (X) des Fahrzeugs gewiinscht wird, k6nnen sie berechnet 
werden, indem man die folgende Gleichung benutzt: 



40 
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Langengrad = tan*" 1 —^ Gl. 6 
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50 Man beachte, daB diese Breitengradgleichungen nur einen ungefahren Breitengrad liefert Die Bestimmung 
eines exakteren Breitengrades macht erforderlich, daB ein komplexes iteratives Verfahren benutzt wird. 

Das GPS-Verarbeitungssystem 312 und Kalmanfiltern 

55 Von der Perspekti ve eines Benutzers ist das GPS-Verarbeitungssystem 312 der wichtigste Teil des autonomen 
Fahrzeugsystems 200. Das GPS-Verarbeitungssystem 312 ist verantwortlich, die Signale von jedem GPS-Satelli- 
ten zu empfangen, die optimalen Sateliiten fur die Verarbettung auszuwahlen, die prazise Position von jedem 
ausgewahlten Sateliiten zu bestimmen, den Pseudoabstand zu jedem Sateliiten zu bestimmen und schlieBlich, um 
die Position des Empfangers abzuschatzen auf Grundlage der Satellitenpositionen und den Pseudoabstanden. 

60 All dies muB gemacht werden unter Benutzung der ernpfangenen Daten (mit stark abgeschwachten Amplitu- 
den), die sehr oft schwer durch Rauschen verfalscht sind (einschlieBlich Rauschen, das von der Atmosphare, dem 
Vorverstarker und dem Empfanger produziert wird). Das GPS-Verarbeitungssystem 312 verlaBt sich in groBem 
MaB auf Kalmanfiltern, um das Rauschen von den GPS-Navigationssignalen zu eliminieren. Kalmanfiltern wird 
in dem GPS-ProzeB 408 durchgefOhrt. 

65 Der Kalmanfilter ist ein rekursiver Algorithmus nach dem Verfahren der kleinsten Quadrate, der normaler- 
weise mit Software oder Firmware auf einem digitalen Computer (Prozessor 308) implementiert ist. In dem 
bevorzugten Ausftthrungsbeispiel nimmt der Kalmanfilter an, daB die verrauschten Signale eher diskret als 
kontinuierlich in ihrer Natur sind. Sowohl die Daten und das Rauschen werden in Vektorform modelliert und die 
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Daten werden rekursiv^^Bbeitet. 

Ein Kalmanfilter leistSffwei Funktionen. Zuerst extrapoliert er eine Datenabschatzung aus fruheren Daten 
Zweitens bringt er die extrapolierte Datenabschatzung auf den neuesten Stand und verfeinert sie auf der 
Grundlage von aktuellen Daten. Zum Beispiel, falls eine Fahrzeugposition pi und Geschwindigkeit vj zu einer 
Zeit ti bekannt sind, dann wird der Filter (indem er den Extrapolationsschritt ausfuhrt) pi und vi benutzen, um 
eine Position p 2 zu einer Zeit t 2 abzuschatzen. Danach (indem er den Erneuerungsschritt, indem er auf den 
neuesten Stand gebracht wird, ausfuhrt), werden neu erlangte Daten einer Zeit t 2 benutzt, um die Positionsab- 
schatzung t2 zu verbessern. Von Daten, die in den Kalmanfilter eingespeist werden, um entweder in Extrapola- 
tion oder in den ErneuerungsWerfeinerungsschritten zu helfen, sagt man, daB sie den Filter "einschranken". 

Kalmanfiltern ist in der Technik sehr wohl bekannt. Fur eine detailliertere Diskussion Ober Kalmanfilter, siehe 
Brown, R. G, "Kalman Filtering: A Guided Tour", Iowa State University; und Kao, Min H, and Eller, Donald H 
"Multiconfiguration Kalam Filter Design for High- Performance GPS Navigation", IEEE Transactions on Auto- 
matic Control, Band AC-28, Nr. 3, Marz 1983, von denen die relevanten Lehren hier durch die Bezugnahme 
aufgenommen sind. 

Gew6hnlich, weil der Kalmanfilter ein linearer Filter ist, werden die oben ausgefiihrten Abstandsgleichungen 
nicht direkt geldst, sondern zuerst linearisiert. Das heiBt, die Gleichungen werden abgeleitet und die Abglei- 
chung jeder Gleichung wird geldst, um eine Veranderung von einer zuletzt bekannten Position zu berechnen. 
Zum Beispiel eine erste Positionsabschatzung zu einem Zeitpunkt ti kann schnell von dem GPS-Prozessor 410 
berechnet werden, indem man die Navigationsgleichung differentiert und nach einer Anderung in der Position 
(AU X , AU y , A U 2 ) von einer zuletzt bekannten Fahrzeugposition (U x , U y , U z )i-t zum Zeitpunkt tj-j aufldst. Dies 2 o 
vereinfacht im groBen MaBe die Losung der Abstandsgleichung. 

Als eine Alternative zu Kalmanfiltern kann eine Abschatzung nach der Methode der kleinsten Quadrate oder 
der am besten passenden Polynomials benutzt werden. 

Die Basisstation 220 

GPS-Daten von einer Konstellation 202 von GPS Satelliten 102 werden ebenfalls von der Basisstation 220 
empfangen. Die Basisstation 220 weist ein externes oder Hostverarbeitungssystem 328 auf. Das externe Verar- 
beitungssystem 328 ist ahnlich dem GPS-Verarbeitungssystem 312 des Fahrzeugs 210 darin, daB es einen 
GPS-Empf anger enthalt (zum Beispiel ein Magna vox Model! MX4818), um die Position der Basisstation in 
Bezug auf den Erdmittelpunkt zu bestimmen. Die Basisstation wird benutzt, um ein "differentielles GPS-System" 
zu realisierea 

In einem differentiellen GPS-System wird eine von GPS berechnete Position der Basisstation dazu benutzt in 
Verbindung mit der bekannten Position der Basisstation, um Fehler oder Abweichung zu berechnen. Indem man 
emen Fehler- oder Korrekturfaktor fur jeden Pseudoabstand produziert, kann die Basisstation Fehler, die in der 
ersten Positionsabschatzung vorhanden sind, quantifizieren und korrigieren. 

Die Basisstation kann Fehler auf eine Vielzahl von Arten berechnen. In dem bevorzugten Ausfuhrungsbeispiel 
wird der von GPS berechnete Pseudoabstand von jedem Satelliten mit einem berechneten Abstand (d) zwischen 
dem Satelliten und'der bekannten Position der Basisstation 220 verglichen. Die Differenz ist ein "differentieller 
Fehler", der von atmospharischen und anderen Fehlern, wie oben diskutiert wurde, bewirkt wird. Die Basissta- 
tion berechnet einen Fehler fur jeden Satelliten, der bei den Positionsberechnungen benutzt wird Diese Fehler, 
wenn sie dem Fahrzeug uber den Kommunikationskanal 225 mitgeteilt werden, konnen benutzt werden, um die 
Genauigkeit der ersten Positionsabschatzung zu verbessern. 

/ 0 D « r * b v sta . nc } . (d) z ™ sche . n einem Satelliten zu einer Position (x, y, z) und einer Basisstation an einer Position 
(B x , By, B z ) wird berechnet, indem man die Standardabstandsgleichung benutzt: 

( X -B x ) 2 + (y-B y ) 2 + (z-B z ) 2 - d 2 (7). 

Die Position (x, y, z) des Satelliten wird aus den ephemerischen Daten des Satelliten berechnet 
Das differemidle GPS-System nimmt an, daB das Fahrzeug 210 relativ nahe zu der Basisstation 220, zum 
Beispiel innerhalb 40 km, sich befindet, so daB die atmospharischen Fehler, die an der Basisstation 220 vorliegen 
ungefahr dieselben sind als die atmospharischen Fehler, die am Fahrzeug 210 vorliegen. Dies erlaubt dem 
Fahrzeug, die erste Positionsabschatzung des Fahrzeugs, die auf Information basiert, die an der Basisstation 
erzeugt wurde, zu korrigieren, d. h. die Genauigkeit zu verbessern. 

Das Bewegungspositionierungssystem (MPS) 314 

Wie oben / diskutiert wurde, schlieBt das MPS 314 einen Fahrzeugkilometefzahler 316 und eine Tragheitsrefe- 
renzeinheit (IRU) 318 ein die die Position des Fahrzeugs auf Grundlage von Veranderungen von einer anfangs 
bekannten Position, verfolgen. Der Fahrzeugkilometerzahler 316 produziert Daten Ober die Distanz oder den 
Abstand, der vom Fahrzeug 210 zuruckgeiegt wurde. Die IRU 318 umfaBt Lasergieroskop(e) 320 und Beschleu- 
nigungsmesser 322, die benutzt werden kdnrien, um Daten uber Position, Geschwindigkeit, Drehune Neiuune 
und Gierung zu prodtmeren. Das MPS 314 liefert die IRU-Daten und die KllometeA^ 
Verarbeitungssystem 324. Ein MPS-Interkommunikationsprozessor 326 steuert das Format der MPS-Daten di^ 
an das VPS-Verarbeitungssystem 324 geliefert werden. Aus diesen Daten produziert da"v^ 
stem 324 eine zweite Positionsabschatzung fur das Fahrzeug 210. eraroeuungssy 
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Das VPS-Verarbeitungssystem 324 

Wie oben erwahnt wurde, kann die erste Positionsabschatzung (FPE) des GPS benutzt werden als eine 
unabhangige Anzeige der Position des Fahrzeugs 210. AhnJich kann die zweite Positionsabschatzung (SPE), die 
5 aus den MPS-Daten berechnet wurde, als eine unabhangige Anzeige der Position des Fahrzeugs 210 verwendet 
werden. In dem bevorzugten Ausffihrungsbeispiel jedoch, werden die ersten und zweiten Positionsabschatzun- 
gen kombiniert durch das VPS-Verarbeitungssystem 324, urn eine genauere dritte oder beste Positionsabschat- 
zung (BPE) zu produzieren. Um dies zu erreichen, verlaBt sich das VPS-System auf Kalmanfiltem und auf 
gewichtetes Mitteln, um optima! die Daten des GPS-Verarbeitungssystems 312 mit den Daten des MPS 314 zu 

to kombinieren. Diese Methode, um ein BPE zu produzieren, ist in dem FluBdiagramm 600 von Fig, 6 dargestellt 

In einem Schritt 602 wird eine optimale Konsteilation von Sateiliten (bezeichnet "SV" far "space vehicle") 
SV1-SV4 ausgewahlt. Wahrend mindestens vier Sateiliten erforderlich sind, kann eine groBere Anzahl benutzt 
werden, um die Genauigkeit einer ersten Positionsabschatzung zu vergr6Bera Die Schritte 603—607 beschafti- 
gen sich damit, einen differentiellen Fehler fur jeden Sateiliten, wie oben diskutiert wurde, zu produzieren. Die 

15 Schritte 608—612 beschaftigen sich damit, unter Benutzung der GPS-Daten und der differentiellen Fehler eine 
genaue erste Positionsabschatzung (FPE) zu berechnen und die FPE mit einer zweiten Positionsabschatzung 
(SPE) des MPS 314 zu kombinieren, um eine dritte oder beste Positionsabschatzung (BPE) zu produzieren. 

Die Berechnung einer differentiellen Abweichung (Fehler) an der Basisstation veriauft folgendermaBen. In 
einem Schritt 603 werden die ephemerischen Daten und die Abstandsdaten von jedem Sateiliten empfangen. 

20 Der Pseudoabstand (PSR) zu jedem Sateiliten wird in einem Schritt 604 bestimmt Dann in einem Schritt 605 
wird die Position jedes Sateiliten berechnet unter Benutzung der ephemerischen Daten und der GPS-Zeit. In 
einem Schritt 606 wird ein Abstand oder Bereich zwischen jedem Sateiliten und der Basisstation berechnet, wie 
oben diskutiert wurde, unter Benutzung der bekannten Position der Basis und der ephemerischen angezeigten 
Position jedes Satellitea In einem Schritt 607 wird der berechnete Pseudoabstand fur jeden Sateiliten verglichen 

25 mit dem berechneten Abstand zwischen der Basisstation und dem entsprechenden Sateiliten. Dieser Vergleich 
liefert einen "differentiellen Fehler" ffir jeden Sateiliten. Die differentiellen Fehler werden an das Fahrzeug 
gesendet zum Gebrauch bei der Berechnung einer genauen ersten Positionsabschatzung. 

Die Berechnung einer besten Positionsabschatzung am Fahrzeug veriauft folgendermaBen. In einem Schritt 
608 werden die ephemerischen Daten und die Abstandsdaten von jedem Sateiliten empfangen. Die Pseudoab- 

30 stande (PSR's) zu jedem Sateiliten werden in einem Schritt 609 bestimmt Dann in einem Schritt 610 wird die 
Position jedes Sateiliten berechnet unter Benutzung der ephemerischen Daten und der GPS-Zeit. In einem 
Schritt 61 1 wird eine FPE berechnet fur das Fahrzeug 210, indem man die Pseudoabstande aus dem Schritt 609, 
die Satellitenposition aus dem Schritt 610 und die differentiellen Fehler von der Basisstation (Schritt 607) 
benutzt. SchlieBlich in einem Schritt 612 werden die zweite Positionsabschatzung vom MPS 314 und die erste 

35 Positionsabschatzung vom Schritt 61 1 kombiniert, um eine dritte oder beste Positionsabschatzung (BPE) fQr das 
Fahrzeug 210 zu produzieren. 

In dem bevorzugten Ausffihrungsbeispiel werden die FPE und die SPE kombiniert, wenn man einen gewichte- 
ten Kombinierer benutzt Weil die FPE inharent genauer ist wird ihr normalerweise mehr Gewicht gegeben als 
der SPE Jedoch, da sowohl die FPE als auch die SPE unabhangig abgeleitet werden, kann jeder von beiden 

40 voiles Gewicht gegeben werden, falls die andere verfalscht wird. Die Gewichtsfaktoren werden zugeschrieben 
auf Grundlage der geschatzten jeweiiigen Genauigkeiten. 

Man beachte, daB die Schritte 603—607 an der Basisstation 220 durchgeffihrt werden, wahrend die Schritte 
608—61 2 gleichzeitig am Fahrzeug 210 durchgeffihrt werden. Falls es gewQnscht wird, konnen die Roh-GPS-Da- 
ten (Pseudoabstande und Satellitenpositionen) von der Basisstation 220 an das Fahrzeug 210 gesendet werden. 

45 Alle Berechnungen kdnnen dann an dem Fahrzeug210 ausgefuhrt werden. 

Wahrend die BPE eine ziemlich genaue Abschatzung der Fahrzeugposition ist ist sie nicht fehlerlos. Wie oben 
diskutiert wurde, schlieBt die erste Positionsabschatzung nicht-lineare Fehler ein, die das differentielle System 
nicht korrigiert Diese Fehler, die Hoch-Prazisionsabschatzungen verhindern, schlieBen Satellitenwackeln und 
atmospharische Effekte ein. 

so Die vorliegende Erfindung ist ein Verfahren und ein System, um diese nicht-linearen Fehler zu modellieren 
und sie in den Positionsgleichungen zu berficksichtigen, so daB eine genauere Positionsabschatzung berechnet 
wird. Die Standardnavigationsgleichung wird modifiziert, um die Fehlerkoeffizienten a, p, y und 6 einzuschlie- 
Ben. a wird benutzt, um die Fehler in der x-Dimension zu modellieren, p wird benutzt, um die Fehler in der 
y-Dimensiori zu modellieren. y wird benutzt, um die Fehler z-Dimension zu modellieren. 6 wird benutzt um die 

55 Fehler in den Pseudoabstanden zu modellieren. 

Weil die Fehlerquellen (die moduliert werden zum Benutzen von a, p, y, und 8 zufailig in ihrer Natur sind, 
werden sie alle Null als Mittelwert haben und fiber die Zeit unvorhersagbar sein. Jedoch fiber eine kurze Periode 
erwartet jnan, daB die Fehlerkoeffizienten Trends folgen, die charakterisiert Werden kdnnen. Es sind diese 
Trends, die yon den Fehlerkoeffizienten modelliert werden. Im wesentlichen tragen die Fehlerkoeffizienten den 

60 Fehler von jedem Sateiliten in der Konsteilation fiber zu einem Fehler in die Fahrzeugposition. Zum Beispiel die 
Fehler in der x-Richtung ffir jeden Sateiliten werden zusammen gemittelt und als ein einziger Fehler in der 
x-Richtung der Fahrzeugposition reprasentiert. So haben die Fehlerkoeffizienten eine Bedeutung nur in der 
besonderen Konsteilation (zum Beispiel die vier ausgewahlten Sateiliten), fQr die sie berechnet wurden. 

Die Koef f izienten a, P, y, und 5 modellieren die Satellitenfehler linear, jedoch werden sie nicht-Iinear, wenn sie 

65 in der Abstandsgleichung quadriert werden: 

(xi-aUx) 2 + (yi-pU y ) 2 + (zj-yUz) 2 - (8PSRi-B d ock) 2 (8) 
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Der Uhrenfehler (Bu^^Brde in diese Gleichung aufgenornmen, um der Stat^^^istandsverschiebung (stea- 
dy state offset) Rechnun^9u tragen in einem Pseudoabstand, der durch ein Uhren- oder Clock- oder Taktdiffe- 
rential verursacht wurde. Der 6-Koeffizient wird irgendwelche nichtJinearen Pseudoabstandsstorungen korri- 
gieren. 

In der Gleichung 8 werden die Fehlerkoeffizienten a, P, y> und 8 multipliziert mit den Fahrzeugpositionskoor- 
dinaten und dem Pseudoabstand, um nicht-Iineare FehJer zu kompensieren. In einem alternativen Ausfuhrungs- 
beispiel der Erfindung konnen Fehlersummanden (nicht Koeffizienten) addiert oder abgezogen werden von den 
jeweiligen Fahrzeugpositionskoordinaten und dem Pseudoabstand Dies ist in Gleichung 9 dargestellt: 

(xi-U x -a) 2 + (y i -Uy~p) 2 + (zi-Uz--Y) 2 -(PSR i ~8-Bciock) 2 (9) 
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Typischerweise, wenn man eine GPS-Positionsberechnung durchfuhrt, mussen Werte ftir vier Variable be- 
stimmt werden. Diese schlieBeri die Fahrzeugpositionskoordinaten U x , U y und U z und den Uhrenfehler ein. Mit 
der vorliegenden Erfindung mussen Wert$ fur vier zusatzliche Variablen berechnet werden. Diese schlieBen die 
Fehlerkoeffizienten a, P, y, und 5 ein. So mussen Werte fur eine Gesamtsumme von acht Variablen berechnet t5 
werden. Eine Ldsung fQr die acht Unbekannten kann auf eine Vielzahl von Arten berechnet werden. Die 
Losungen kdnnen ein GPS-System mit offenem Ende (ohne die Basisstation 220) oder ein differentielles GPS-Sy- 
stem (mit der Basisstation 220) benutzen. Beide Anwendungen werden im Detail unten diskutiert. 

Das GPS-System mit offenem Ende 20 

In einer ersten Anwendung ftir die Erfindung wird ein nicht differentielles GPS-System (mit offenem Ende) 
benutzt In einem ersten Ausfuhrungsbeispiel fur diese Anwendung werden acht Satelliten (SVi, wobei i= 1— >8) 
im Zusammenhang mit Gleichung 8 benutzt werden, um acht Abstandsgleichungen zu erzeugen. Diese Glei- 
chungen werden dann benutzt, um nach U x , U y , U 2 , a, p, y, 8 und dem Uhrenfehler aufzuldsen. Wahrend dieses 25 
erste Ausfuhrungsbeispiel geradewegs eine Losung fur das Problem darstellt, wird eine Konstellation, die acht 
Satelliten umfaBt, nicht immer in dem NAVSTAR GPS verfugbar sein. So kann diese Ldsung nicht praktikabel 
ftir alle Systeme sein. 

In einem zweiten Ausfuhrungsbeispiel werden die Fehlerkoeffizienten berechnet, indem man nur sechs 
Satelliten (SVj, wobei i « 1— »6) benutzt Dieses Verfahren ist in einem FluBdiagramm 700, das in Fig. 7 gezeigt ist, 30 
dargestellt. In einem Schritt 702 wird eine Anfangspositionsabschatzung (PE) berechnet unter Benutzung von 
Daten von vier Satelliten (zum Beispiel SVi, SV 2 , SV 3 und SV 4 ) und den folgenden Gleichungen: 

(xi ~U X ) 2 + (y, -Uy) 2 4- (z, -U z ) 2 - (PSR, -Bdock) 2 (10) 

(x 2 -Ux) 2 "+ (y 2 -U y ) 2 4- (z 2 _U 2 ) 2 - (PSR 2 -B c iock) 2 (11) 

(x 3 -Ux) 2 + (y 3 -U y ) 2 + (z 3 -Uz) 2 - (PSR 3 -B C iock) 2 (12) 

(x 4 -Ux) 2 + (y 4 -U y ) 2 + (Z4-U 2 ) 2 = (PSR4-B c iock) 2 (13) 

Als nachstes in einem Schritt 704 werden Werte fur a, 0, y, und 6 berechnet, indem man die Anfangs-PE (U x , 
U y , U z ) und Buhr, die im Schritt 702 berechnet wurden, Daten von den Satelliten SV3, SV4, SV 5 und SVe und den 
folgenden Gleichungen verwendet: 

(x 3 -aU x ) 2 + (y3-PUy) 2 + (Z3-YUz) 2 - (8PSR 3 -Bdock) 2 (14) 

(x 4 -aU x ) 2 + (y 4 ~pUy) 2 + (z4-yU z ) 2 - (5PSR 4 -B C iock) 2 (15) 

(xs-aUx) 2 + (y 5 -pu y ) 2 .+ (25- yU 2 ) 2 - (6PSR5- B c iock) 2 (16) 

(xe-aUx) 2 + (ye-pUy) 2 + (26-yUz) 2 - (5PSR 6 -B c iock) 2 (17) 

Die Werte fur a, p, y, und 8 werden dann in die Gleichungen fur die Satelliten SVi, SV 2 , SV3 und SV 4 in einem 
Schritt 705 eingesetzt. Dies resultiert in den Gleichungen : 

(x,-aUx) 2 + (yi-PU y ) 2 + (2,-yUz) 2 = (8PSR,- B d0 ck) 2 (18) , . - . 

(x2-aU x ) 2 + (y 2 -pUy) 2 + (22-yUz) 2 = (SPSR 2 -Bciock) 2 (19) 

(x 3 -aUx) 2 + (y 3 -pU y ) 2 + (23-yU z ) 2 - (5PSR 3 -B c iock) 2 (20) 

(x 4 -aU x ) 2 -h(y4~pUy) 2 + (z4-yU 2 ) 2 = (8PSR4-B c , ock )2 (21) ' 

Aus diesen modifizierten Gleichungen fQr die Satelliten SVi, SV 2 , SV 3 und SV 4 wird eine neue PE (U x U v U 7 ) ^ 
in einem Schritt 708 berechnet y ' ; 

In einem Schritt 710 wird die neue PE (von einem Schritt 708) mit der Anfangs-PE (von einem Schritt 702) 
verghchen. Fails der Unterschied zwischen den beiden PE's weniger oder gleich einer vorherbestimmten 
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i ^(fcrechnungen am Schritt 712. Falls jedoch der Unter^^ri j 

nn schreitet das Verfahren welter zu einem Schritt 7 14. 



Schwelle ist, dann enden l^pirechnungen am Schritt 712. Falls jedoch der Unter^Pa grdBer als die vorherbe- 
stimmte Schwelle ist, dann < 

Im Schritt 714 werden die anfangliche PE und die neue PE gemittelt, urn eine mittlere PE zu produzieren. Das 
Verfahren kehrt dann zum Schritt 704 zurilck, wo die mittlere PE benutzt wird, urn erneut die Fehlerkoeffizien- 
5 ten zu berechnen. So ist das Verfahren 700 ein iterativer ProzeB, der so lang wiederholt wird, bis die Differenz 
zwtschen dem neuen PE'und der Anfangs PE (oder mittleren PE) weniger oder gleich einer vorherbestimmten 
Schwelle ist Wenn das Verfahren sich wiederholt, werden alle aufeinanderfolgend berechneten PE's gemittelt, 
um die mittlere PE in einem Schritt 714 zu berechnen. 
Die vorherbestimmte Schwelle wird ausgewShlt, um eine gewilnschte Genauigkeit fur die PE zu erreichen. 
io Wenn sich die Schwelle der Null nahert, wird die Genauigkeit der PE sich erhdhen. Jedoch ist der Preis filr die 
grftBere Genauigkeit eine erhohte Anzahl von Iterationen der Schritte 704, 706, 708, 710 und 714. Dies hat eine 
erhdhte Rechenzeit zur Folge. 

Als eine Alternative zum Schritt 714, wo eine mittlere PE berechnet wurde, kann die anfangliche PE auf den 
Wert der neuen PE gesetzt werden und die neue PE kann dazu benutzt werden, in einem Schritt 704 erneut die 
15 Fehlerkoeffizienten zu berechnen. Jedoch wird diese Alternative mehr Iterationen erforderlich machen, um an 
der idealen Positionsabschatzung zu konvergieren. 

In jedem der hier diskutierten Ausfuhrungsbeispiele kann eine prazise Zeitreferenz, wie zum Beispiel eine 
Atomuhr, in dem Empfanger 406 benutzt werden. Dies wird den Uhrenfehler aus den Berechnungen eliminieren 
und prazise Positionsabschatzungen mit einem Satelliten weniger erlauben. Zum Beispiel in dem direkt oben 
20 diskutierten AusfUhrungsbeispiel miissen nur fiinf Satelliten benutzt werden, um eine prazise Positionsabschat- 
zung zu berechnen. In diesem Fall konnte der Schritt 702 Daten von den Satelliten SVi, SV 2 und SV 3 benutzen 
und der Schritt 704 kdnnte Daten von den Satelliten SV2, SV 3 , SV 4 und SV 5 benutzen. 

Alternativ kann der Uhrfehlerfaktor (Buhr) aus den Positionsberechnungsgleichungen eliminiert werden und 
in den 8 Fehlerkoeffizient aufgenommen werden. In diesem Fall wird der 8 Fehlerkoeffizient fur den Uhrenfehler 
25 kompensiert. Dieser Ansatz wiirde ebenfalls einen Satelliten weniger fur die Positionsberechnung bedeuten. 
Jedoch kann der 8 Fehlerkoeffizient nicht einheitlich ein festes Uhrendifferential kompensieren, indem man 
einen konstanten Wert mit sich andernden Pseudoabstandswerten multipliziert. So mQBte eiri Wert fQr 8 
ausgewahlt werden, der einen KompromiB von dem idealen Wert ist Aus diesem Grund ist dieser Ansatz nicht 
bevorzugt. 

30 In der bevorzugten Implementierung dieses Ausfuhrungsbeispiels wird die anfangliche PE, die im Schritt 702 
berechnet wurde, tatsachlich eine beste Positionsabschatzung (BPE) sein. Dies wird eine genauere Anfangsposi- 
tionsabschatzung produzieren, die ihrerseits dem Verfahren 700 erlaubt, auf eine L6sung schneller zu konvergie- 
ren. Tatsachlich sind irgendwelche zusatzlichen Einschrankungen, die die Konvergenz einer Ldsung untersttit- 
zen, erwQnscht, weil die Ldsung fur die Fehlerkoeffizienten einen massiven Betrag von Rechnen mit sich bringt, 

35 was sehr schnell durchgefuhrt werden muB, um die notwendige Positionsinformation an ein Fahrzeug zu liefern. 
Diese zusatzlichen Einschrankungen kdnnen zum Beispiel Daten einschlieBen von: einem Laserabtast- oder 
-reichweitensystem, das Laserziele mit bekannten festen Positionen besitzt, eine Basisstation, eine Pseudolite 
und/oder einer Fahrzeuggeschwindigkeitsmessung. 
Das Aufldsen nach den Fehlerkoeffizienten (a, p, y, und 8) in den Gleichungen von Schritt 704 kann sehr 

40 komplex werden. Ein Beispiel einer Losung unter Benutzung von Storungstheorie folgt Man beachtet, daB fOr 
die Vereinfachung der Diskussion kein Uhrenfehler in die Berechnungen eingeschlossen ist. 
Man reprasentiere jeden Satelliten SVj mit der folgenden generischen Gleichung: 

(xi-ctUx) 2 + (yi-pU y ) 2 + (zi- Y Uz) 2 - 8PSRi 2 (22) 

Ersetze a - 1 -e x , P - 1 -e y , y — e z \3 und 8 = 1 -e p (man beachte, daB e x , Syz, &z und e p ungefahr gleich O sind), um 
zuerhalten: 

(xj-Ux-f exUx) 2 + (yi-Uy + eyUy) 2 + (zi-Uz + ezty 2 - (PSRi-ep) 2 (23) 

Falls diese Gleichung entwickelt wird und die Ausdrucke (e x Uy) 2 , (EyU y ) 2 , (ezUz) 2 und (e p PSRj) 2 als sehr klein 
angenommen werden verglichen mit den Ausdrucken (xrU x ), (yi-U y ), (zi-U 2 ) und PSRi 2 angenommen wird, dann 
konnen die Ausdrucke (e x U x ) 2 (e y U y ) 2 , (e 2 U z ) 2 und (e P PSRi) 2 vernachlassigt werden. Das ergibt: 

55 (xi-Ux 2 )-2c x (xj-U x ) + (yi~U y ) 2 -2e y U y (yi~Uy) + (zi~U 2 ) 2 -^2e 2 Uz(zi~U 2 ) = (PSRi) 2 ~2(PSR0 2 e P (24) 

Als nachstes definiere Fi =» (xi-U x ) 2 -I- -(yi-UyJ 2 + (zi-Uz) 2 und setze das in die obige Gleichung ein, um zu 
erhalten: 

60 ^-e x U x (x i -U x )-eyUy(yi-Uy)~ezU z (zi^U 2 )-he p (PSRi) 2 = 0 (25) 

Sind die. vier Satelliten (SV 2l SV 3 , SV 4 und SV 5 ) aus dem oben diskutierten Schritt 704 gegeben, kann diese 
65 Gleichung dazu benutzt werden, um die folgenden vier Gleichungen zu produzieren: 

-y- - £xU x (x 2 - U x ) - EyUyfe- Uy) - e 2 U z (z 2 -~U 2 ) 4- CKPSR2) 2 - 0 (26) 
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- exUx(x 3 -U x ) - yU&s-Uy) - ezUz{z3-Uz) + etfPSRj)* = 0 (27) 



- e x U x (x4-Ux) - c y Uy{y4-U y ) - ezUz(z4- U ? ) + eKPSRa) 2 = 0 (28) 



- e x Ux(x 5 -Ux) - tyV/ys-Vy) - e 2 U 2 (z 5 -U z ) + eKPSRs) 2 - 0 (29) 



Satellit Nr. 
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29 
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Diese vier Gleichungen werden dann durch Ersetzung nach e x , e y , e 2 und e p aufgelost. 

Ein spezifisches, numerisches Beispiel von der Verbesserung der Prazision einer Positionsabschatzung, die 
durch die Erfindung erreicht werden kann, wird unten geliefert. Die Berechnungen wurden auf einem Allzweck- 15 
computer durchgefQhrt, indem man ein mathematisches Programm (math spreadsheet program) benutzt Die 
ideale Fahrzeugposition (U*, U y , U z ) ist (1, 2, 3). Die funf Satelliten, die fur das Beispiel benutzt werden, haben die 
folgenden Positionen und Pseudoabstande: 



20 



25 



30 
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Falls der Pseudoabstand (PSR 2 ) fur den Satelliten Nr. 2 mit einem 0,0001 %igen Fehler (d. h. PSR 2 2 = 29,00003) 
gestdrt wird, dann wird sich die ergebende Fahrzeugpositionsabschatzung (Schritt 702) fGr das Fahrzeug von (1, 
2, 3) auf (1,002182; 1,995608; 3,002225) fur das Fahrzeug verandern. Dies reprasentiert einen Positionierungsfeh- 
ler von (0,21 8% ; -0,220% ; 0,074%) in der x-, bzw. y- bzw. -Richtung. 

Falls die Daten der Satelliten Nr. 2, Nr. 3, Nr. 4 und Nr. 5 in Verbindung mit der Anfangspositionsabschatzung 
benutzt werden, urn Werte zu berechnen (Schritt 704) fur die Fehlerkoeffizienten, erhalt man die folgenden 
Werte: . 

ex = 0,00439 
ey = —0,00440 
er = 0,00147 
ep = -2,4 xlO' 6 . 

Man erinnere sich daran, daB a » 1 -e x , p = l-e y , y- 1 -e 2 und 6 = 1 -e p gilt Die Werte von a, p, y, und 6 konnen 50 
dann benutzt werden, urn erneut die Fahrzeugposition zu berechnen (Schritte 706 und 708) unter Benutzung der 
Daten der Satelliten Nr. I, Nr. 2 und Nr. 3, um eine verfeinerte Fahrzeugposition zu produzieren. Dies hat eine 
verfeinerte Fahrzeugposition von (0,9987; 2,0025; 2,9987) zur Folge. Die verfeinerte Fahrzeugposition schlieBt 
einen Fehler von (-0,1253%; 0,1269%; - 0,0443%) f Or die x-,y- bzw. z-Richtungen eia 

Man vergleiche den Fehler in der Anfangsposition mit dem Fehler in der verfeinerten Position. Man beachte, 
daB der Fehler sinusformig variiert, wenn er auf die Idealposition konvergiert Mit zus^tzlichen Iterationen wird 
die Losung auf der idealen Position konvergieren. Jedoch ist eine effizientere Methode des Konvergierens auf 
der Idealldsung, die mittlere Positionsabschatzung zu finden. Zum Beispiel der Durchschnitt oder Mittelwert der 
Anfangspositionsabschatzung der verfeinerten Positionsabschatzung wird eine mittlere Positionsabschatzung 
von ( 1 ,004 ; 1 ,99 1 ; 3,0004) produzieren. Diese mittlere Positionsabschatzung spiegel t einen Fehler von der idealen 
Position von (0,0464%; ~o,0463%; 0,01 50%) in der x-, bzw. y- bzw. z-Richtung wieder. So hat die Erfindung eine 
80%ige Vernngerung im Positionsfehler ergeben. Mitteln der Positionsabschatzungen von zusatzlichen sukzes- 
siven Iterationen der Methode 700 werden in einer weiteren Zunahme in der Prazision der letzten Positionsab- 
schatzung resultieren. 

Fehler in den ephemerischen Daten (d. h. Sateilitenposition) werden sich auf den Effekt entsprechend dem 
Pseudoabstand auswerten. Deshalb konnen alle Sateliitenfehler effektiv als eine Pseudoabstandstorung model- 
hert werden Man beachte, daB das oben fortgefuhrte Beispiel eine Stoning von nur einem Pseudoabstand 
einschheBt. Falls die Daten von mehr als einem Satelliten gestdrt werden, wird das Verfahren der Erfindung 
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fortfahren, eine Anwend^^i haben Jedoch eine grdBere Lnzahl von iTcraiio^££fcirR ben6tigt werden, urn 
eine gewtinschte Zunahmeder Positionierungsgenauigkeit zu erreichen. 

In einem dritten Ausfiihrungsbeispiel der Erfindung werden nur vier Sateliiten bendtigt, um eine prazise 
Fahrzeugpositionsabschatzung zu berechnen. Dies ist in der Methode 800 von Fig. 8 dargestellt In einem Schritt 
5 802 werden GPS-Navigationssignale am Fahrzeug 210 zu einer Zeit ti von mindestens vier Sateliiten empfan- 
gen. Zu einer Zeit U befindet sich das Fahrzeug in einer Position Pi (Ux, U y , U z ). Ahnlich in einem Schritt 804 
werden GPS-Navigationssignale am Fahrzeug 210 zu einer Zeit t2 empfangen. Zur Zeit t2 befindet sich das 
Fahrzeug an einer Position P2,wobei P 2 - Pi+At-v = (U x 4-At-v x , U y + At«v y ,U z + At-v 2 ). Atistgleich t2-ti- v 
ist gleich der Durchschnittsgeschwindigkeit des Fahrzeugs, wenn es zwischen Pi und P 2 sich fortbewegt. Die x-, 
10 y-und z-Komponenten der Geschwindigkeit (v x , v y , v 2 ) konnen genau aus der Phase der TrMgerwelle der 
GPS-Navigationssignale bestimmt werden, indem man akkumulierte Delta-Bereichstechniken benutzt, wie es in 
derTechnik bekannt ist. 

In einem Schritt 806 werden die Navigationsdaten von den Schritten 802 und 804 benutzt, um Werte ftir die 
Fehlerkoeffizienten a, 0, y, und 5 und eine prazise Position des Fahrzeugs zu berechnen. Die Berechnung kann 
t5 ausgefilhrt werden zum Beispiel unter Benutzung der folgenden acht Gleichungen: 

(x, -aUx) 2 + (y» -pu y ) 2 + (zi - Y U 2 ) 2 - (8PSR, -Bciock) 2 (30) 

(x 2 _aU x ) 2 + (y 2 -PU y ) 2 + (z 2 -yUz) 2 = (6PSR 2 ~B c iock) 2 (31) 

20 

(x 3 -aU x ) 2 + (ya-pUy) 2 + (z 3 -yU z ) 2 - (8PSR 3 -Bdock) 2 (32) 

(x 4 -aU x ) 2 + (y4-PU y ) 2 + (z4- Y Uz) 2 - (6PSR4-B c iock) 2 (33) 
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30 

(> 

Diese acht Gleichungen erlauben die Ldsung von Werten fur die acht Unbekannten: a, P, y, 8, U x , U y , U z und 
Buhr. Man beachte, daQ die Gleichungen 30—33 Sateliitenpositionen benutzen (zum Beispiel xi, yi, zi) und 

35 PseudoabstSnde (z. B. PSRt) zum Zeitpunkt ti, wahrend die Gleichungen 34—37 Sateliitenpositionen (zum 
Beispiel xi, yu zi) und PseudoabstSnde (zum Beispiel PSRj) zum Zeitpunkt t2 benutzen. So werden die Variablen, 
die benutzt werden, um die Sateliitenpositionen und die Pseudoabstande in den ersten vier Gleichungen zu 
repr£sentieren, verschiedene Werte als in den zweiten vier Gleichungen besitzen, weil sie zu verschiedenen 
Zeiten aufgenommen wurden. 

40 Sind einmal die Fehlerkoeffizienten berechnet, kohnen sie an der nachsten Zeit t„ benutzt werden, um eine 
prSzise Positionsabschatzung fur das Fahrzeug oder Benutzung dieser vier Sateliiten zu berechnen. Dies ist im 
Schritt 808 dargestellt. Es wird angenommen, daB die Werte der Fehlerkoeffizienten, die auf diese Weise 
berechnet wurden, benutzt werden konnen, um die Genauigkeit der ersten Positionsabschatzungen fQr eine 
Zeitdauer in dem Bereich von einigen Minuten bis so lang, als wie die ausgewahlte Konstellation der vier 

45 Sateliiten sich im Blick befindet, erhoht werden kann. Danach werden die Schritte 802— 806 wiederholt werden, 
um neue Werte fQr die Fehlerkoeffizienten zu berechnen. 

Alternativ kann der Schritt 808 ausgelassen werden und die Schritte 802—806 kdnnen wiederholt werden fur 
jede Fahrzeugpositionsberechnung. Die Fehlerkoeffizienten werden kontinuierlich zu jeder Zeit berechnet, 
wenn eine erste Positionsabschatzung berechnet wird. Dies hat das kontinuierlich e Verbessern der Fehlerkoeffi- 

50 zienten und im Ergebnis eine genauere erste Positionsabschatzung zur Folge. Falls es gewQnscht wird, kann ein 
Kalmanfilter benutzt werden, um die Fehlerkoeffizienten zu glatten. 

Es wird vorweggenommen, daB die Erfindung, die durch die oben ausgefuhrten Ausfuhrungsbeispiele darge- 
legt worden ist, Positionsabschatzungen liefern wird, die genau innerhalb eines Bruchteiis eines Meters sind, 
ohne die Benutzung einer Basisstation. 



Ein differentielles GPS-System 



Eine Basisstation 220 wird oft verfugbar sein zum Gebrauch in den Fahrzeugpositionsberechnungen. Eine 
Basisstation kann die Genauigkeit fur die Ldsung der Fehlerkoeffizienten a, P, y, und 5 vereinfachen und 

60 verbessern. Zum Beispiel kann die Basisstation 220 Navigationssignale von funf Sateliiten (SVj, SV2, SV3, SV4 
und SV5) empfangen. Die Pseudoabstande und die Sateliitenpositionen von diesen fQnf Sateliiten k6nnen dann 
im Zusammenhang mit der bekannten Position der Basisstation 220 benutzt werden, um die ftinf Gleichungen 
hach a, p, y, 8 und Buhr aufzul6sen. Die Fehlerkoeffizienten konnen dann an das Fahrzeug uber eine Radiover- 
bindung gesendet werden zum Gebrauch beim Verbessern der Genauigkeit der Positionsbestimmung fur das 

65 Fahrzeug. Das Fahrzeug kann dann seine Position berechnen mit Benutzung von mindestens vier der fQnf 
Sateliiten, die von der Basisstation benutzt werden und die Fehlerkoeffizienten, die von der Basisstation empfan- 
gen werden. 

Dies ist in Fig. 9 dargestellt. In einem Schritt 902 werden die ephemerischen Daten und die Abstandsdaten von 

12 
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jedem Satelliten 102 ari^^wasisstation 220 empfangen. Der Pseudoabstand (iVHzu jedem Satelliten wird in 
einem Schritt 904 bestiimm Dann in einem Schritt 906 wird die Position jedes Satelliten berechnet unter 
Benutzung der ephemerischen Daten und der GPS-Zeit. In einem Schritt 908 werden die Pseudoabstande, die 
Satellitenpositionen und die bekannte Position (Bx, B y> B z ) der Basisstation benutzt, um Werte fOr den Uhrenfeh- 
ler und die Fehlerkoeffizienten a, p, y, und 8 zu berechnen unter Benutzung der folgenden Gleichungen: 
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Fig, 3: 

102 GPS Satelliten 
210 Fahrzeug 
220 Basis Station 
230Pseudolite(s) 

310 Fahrzeugpositionierungssystem (VPS) 
.312GPS Verarbeitungssystem 
314 Bewegungspositionierungssystem (MPS) 
316 Fahrzeugkildmeterzahler 
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Da man fur den Uhrenfehler in den Gleichungen Rechnung tragen muB, werden funf Satelliten bendtigt, um 
nach den Fehlerkoeffizienten aufzuldsen. 

Sind einmal die Werte fUr die Fehlerkoeffizienten berechnet, werden die Fehlerkoeffizienten an das Fahrzeug 
ubertragen in einem Schritt 9 1 0 Uber den Kommunikationskanal 225. 20 

Gleichzeitig mit der Ausftihrung der Schritte 902, 904, 906 an der Basisstation 220 werden die entsprechenden 
Schritte 903, 905, 907 an dem Fahrzeug 210 ausgefuhrt Nur vier der funf Satelliten brauchen an dem Fahrzeug 
verwendet werden. Jedoch konnen alle funf Satelliten benutzt werden fur eirie bessere Genauigkeit Nach dem 
Empfang der Fehlerkoeffizienten von der Basisstation kann das Fahrzeug eine prazise Positionsabschatzung in 
einem Schritt 909 berechnen (zum Beispiel unter Benutzung der oben angegebenen Gleichungen 30— 33). 2 5 

Ebenso bei den anderen Ausfuhrungsbeispielen, die hier beschrieben werden, gilt, wenn Prazisionsuhren 
verwendet werden, konnen die Uhrenfehler aus den Berechnungen entfernt werden und nur vier Satelliten 
werden benotigt, um genau eine Fahrzeugposition zu berechnen unter Benutzung eines differentiellen GPS-Sy- 
stems. 

Die Erfindung kann ebenfalls benutzt werden als eine Methode, um die Genauigkeit von berechneten Posi- 30 
tionsabschatzungen zu messen. Das heiB, falls eine berechnete Fahrzeugposition genau ist, dann werden die a, % 
Y, und 8~Koeffizienten sich der Eins nahern (d. h. das e x , e y , e 2 und e p Koeffizienten werden jeder sehr nah an Null 
sein). Jede Abweichung von Eins stellt einen Fehler von der prazisen Position dar. 

Noch eine andere Anwendung fQr die Erfindung ist die optimalen Satelliten in der Konstellation auszuwahlen 
zur Benutzung in der Berechnung einer PE. Zum Beispiel, falls acht Satellinten in einer Konstellation anwesend 35 
sind, dann sind siebzig mogliche Kombinationen von vier Satelliten verfugbar zum Gebrauch in den PE-Berech- 
nungen. Die a, P, y, und 8 Koeffizienten konnen fur jede mogliche Kombination berechnet werden, um zu 
bestimmen, welche Kombination deri kleinsten Positionsfehler produziert (d h. die Koeffizienten, die am nach- 
sten bei der Eins sind). 

Noch eine weitere Anwendung fur die Erfindung ist eng verwandt mit der unmittelbar oben diskutierten. 40 
Indem man jede der Permutationen von moglichen Satellitenkombinationen benutzt, kann ein Durchschnitts- 
wert fUr jeden Fehlerkoeffizienten berechnet werden. Diese Durchschnittswerte konnen dann benutzt werden 
bei der Berechnung einer Fahrzeugposition. 

Wahrend die Erfindung besonders aufgezeigt und beschrieben wurde in Bezug auf einige bevorzugte Ausfuh- 
rungsbeispiele davon, wird von dem Fachmann verstanden werden, daB verschiedene Abanderungen in Form 45 
und Detail darin gemacht werden kdnnen,ohne von dem Geist und Geltungsbereich der Erfindung abzuweichen. 

Zusammenfassend sieht die Erfindung folgendes vor: Die Genauigkeit einer Positionsabschatzung, die unter 
Benutzung eines satellitengestutzten Navigationssystems erzeugt wird, wird verbessert, indem man fur nicht 
lineare Fehler in den Fahrzeugpositionsberechnungen Rechnung tragt Die Standardnavigationsgleichung wird 
modifiziert, um Fehlerkoeffizienten a, p, y, und 8 einzuschlieBen. a wird benutzt, um Fehler in der x-Dimension zu 
modulieren. p wird benutzt, um Fehler in der y-Dimension zu modulieren. y wird benutzt, um Fehler in der 
z-Dimension zu modulieren. 8 wird benutzt, um Fehler in den Pseudoabstanden zu modulieren. Die Fehlerkoeffi- 
zienten konnen berechnet werden unter Benutzung eines GPS-Systems mit offenem Ende oder eines GPS-diffe- 
rentiellen GPS-Systems. Die Fehlerkoeffizienten konnen in der reellen Zeit berechnet werden und fUr eine 
Periode danach benutzt werden. Einmal berechnet, konnen die Fehlerkoeffizienten als Faktoren in die Berech- 
nung einer Fahrzeugpositionsabschatzung fQr gesteigerte Prazision eingehen. 
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5 326 MPS Interkommunikationsprozessor 
328 Externes oder Hostverarbeitungssystem 

Fig. 4: 

402 GPS Antenne 
io 404 Vorverstarker 
406 GPS Empfanger 
408GPSProzessor 

Fig. 6 : 

15 602 WShle eine optimale Konstellation aus (SV| SV4) 

603 Empfange ephemerische Daten und Abstandsdaten von jedem SV an der Basisstation 

604 Berechne den PSR zu jedem SV von der Basisstation 

605 Benutze die GPS Zeit und die ephemerischen Daten, urn die Position jedes SV zu bestimmen 

606 Benutze die Position jedes SV und die bekannte Position der Basisstation, urn einen Abstand fur jeden 
20 Satelliten zu berechnen 

607 Vergleiche jeden PSR mit dem entsprechenden berechneten Abstand urn einen differentiellen Fehler zu 
erhalten 

608 Empfange ephemerische Daten und Abstandsdaten von jedem SV am Fahrzeug 

609 Berechne den PSRzu jedem SVvom Fahrzeug 

25 610 Benutze die GPS Zeit und die ephemerischen Daten, um die Position jedes SV zu bestimmen 

611 Benutze die Position jedes SV, die berechneten PSR's und die differentiellen Abweichungen von der 
Basisstation, um eine FPE f Qr das Fahrzeug zu berechnen 

612 Benutze die SPE des MPS und die FPE, um eine BPE fur das Fahrzeug zu produzieren 



30 Fig 7: 

702 Berechne eine anfSngliche PE (U x > U y , U 2 ) unter Benutzung der Satelliten SVi, SV2, SV3, und SV4 

704 Berechne Werte fur a, p, y, und 8 unter Benutzung der anfanglichen PE und der Daten von den Satelliten SV3, 

SV4,SV 5 ,undSV 6 

706 Setze a, p, y. und 8 in die Gleichungen fur die Satelliten SVi, SV2, SV 3 , und SV 4 
35 708 Berechne eine neue PE (Ux, U y , U z ) fur das Fahrzeug unter Benutzung der modifizierten Gleichungen fur die 
Satelliten SVi, SV 2 . SV 3 , und SV 4 

710 Ist(Anfanglichen PE — die neue PE) < Schwellenwert? 
712Ende 

714 Berechne eine mittlere PE 

40 

Fig. 8: 

802 Empfange GPS Navigationssignale an dem dem Fahrzeug, das sich an der Position Pi (U x> U y , U 2 ) befindet, 
von mindestens vier SV's zur Zeit ti 

804 Empfange GPS Navigationssignale an dem Fahrzeug, das sich in einer Position Pi befindet von mindestens 
45 vier SV's zur Zeit t2, wobei P2 = Pt + At • v 

806 Berechne die Fahrzeugposition zur Zeit ti und die Fehlerkoeffizienten a, p, y, und 8 unter Benutzung der 

Navigationssignale von ti und t2 und die Geschwindigkeit des Fahrzeugs zwischen den Zeiten ti und t2 

808 Benutze die Fehlerkoeffizienten um eine genaue Fahrzeugspositionsabschatzung zum Zeitpunkt t n zu 

berechnen 

50 

Fig9: 

902 Empfange Satellitennavigationssignale an der Basisstation 

903 Empfange Satellitennavigationssignale am Fahrzeug 

904 Berechne einen PSR yon der Basisstation zu jedem SV 
55 905 Berechne einen PSR von der Basisstation zu jedem SV 

906 Benutze die GPS Zeit und die ephemerischen Daten, um die Position jedes SV zu bestimmen 

907 Benutze die GPS Zeit und die ephemerischen Daten um die Position jedes SV zu bestimmen 

908 Benutze die PSR's, SV Positionen und die bekannte Position der Basisstation, um nach den Fehlerkoeffizien- 
ten a, p,y, und 8 aufzulosen 

60 909 Benutze die PSR's und SV Positionen an dem Fahrzeug zusammen mit den Fehlerkoeffizienten von der 
Basisstation, um eine prazise erste Positionsabschatzung fOr das Fahrzeug zu berechnen 
910 Obertrage die Fehlerkoeffizienten an das Fahrzeug 

Patentanspruche 

65 

1. Ein Verfahren zum Berechnen der Position eines ersten Empfangers auf oder in der Nahe der Erdoberfla- 
che unter Benutzung eines zweiten Empfangers, der eine bekannte Position besitzt, und unter Benutzung 
eines satellitengestatzten Navigationssystems, das eine Konstellation von Navigationssatelliten hat, wobei 
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das Verfahren folg^^^chritte aufweist: 

a) Empfangen von einer Konstellation von Navigationssateliiten, einer ersten Vielzahl von Naviga- 
tionssignalen an einem ersten Empfanger; 

b) Empfangen von einer Konstellation von Navigationssateliiten, einer zweiten Vielzahl von Naviga- 
tionssignalen an dem zweiten Empfanger; 

e) Berechnen eines ersten Fehlerkoeffizienten, der einen Fehler in der x-Richtung far die Position des 5 
zweiten Empfangers darstellt aus der zweiten Vielzahl von Navigationssignalen und der bekannten 
Position des zweiten Empfangers; 

d) Berechnen eines zweiten Fehlerkoeffizienten, der einen Fehler in der y-Richtung f Or die Position des 
zweiten Empfangers darstellt, aus der zweiten Vielzahl von Navigationssignalen und der bekannten in 
Position des zweiten Empfangers; 

e) Berechnen eines dritten Fehlerkoeffizienten, der einen Fehler in einer z-Richtung fur die Position des 
zweiten Empfangers darstellt aus der zweiten Vielzahl von Navigationssignalen und der bekannten 
Position des zweiten Empfangers; und 

0 Berechnen einer prazisen Position des ersten Empfangers unter Benutzung der ersten Vielzahl von 15 
Navigationssignalen und der Fehlerkoeffizienten. 

2. Das Verfahren nach Anspruch 1, das weiter einen Schritt umfaBt vor dem Schritt (f): 

g) Berechnen eines vierten Fehlerkoeffizienten, der einen mittleren Pseudoabstandsfehler reprasen- 
tiert aus der zweiten Vielzahl von Navigationssignalen und der bekannten Position des zweiten 
Empfangers. 

3. Das Verfahren nach Anspruch 2, wobei die Schritte (c), (d), (e) und (g) des Berechnens am zweiten 2 ° 
Empfanger ausgefuhrt werden und der Schritt (0 des Berechnens an dem ersten Empfanger ausgefuhrt 
wird, wobei das Verfahren weiter einen Schritt zwiscfien den Schritten (g) und (0 aufweist: 

h) Obertragen der Fehlerkoeffizienten von dem zweiten Empfanger zum ersten Empfanger 

4. Das Verfahren nach Anspruch 3, wobei die Konstellation von Navigationssateliiten vier Satelliten umfaBt ™ 

5. Das Verfahren nach Anspruch 2, wobei die Schritte (c), (d), (e), (0 und (g) des Berechnens am ersten 
hmpfanger ausgefuhrt werden, wobei das Verfahren ferner zwischen den Schritten (b) und (c) die folzenden 
Schritte umfaBt: ' 6 

h) Berechnen am zweiten Empfanger einer Satellitenposition und eines Pseudoabstands fQr jeden 
Satelliten aus der zweiten Vielzahl von Navigationssignalen; und 

i) Obertragung der Satellitenposition und der Pseudoabstande an den ersten Empfanger. 

6 : Das Verfahren nach Anspruch 5, wobei die Konstellation von Navigationssateliiten vier Satelliten 
emschheBt. 

7. Ein Verfahren urn die Position eines Empfangers auf oder in der Nahe der Erdoberfiache unter Benutzung 
eines satelhtengestutzten Navigationssystems zu berechnen, das eine Konstellation von Navigationssatelli- « 
ten umfaBt, wobei das Verfahren folgende Schritte aufweist: . 35 

a) Auswahlen einer ersten Vielzahl von Satelliten aus der Konstellation; 

b) Berechnen fur jeden Satelliten in der ersten Vielzahl von Satelliten, einer ersten Satellitenposition 
und eines ersten Pseudoabstands; . 

c) Berechnen einer Positionsabschatzung fur das Fahrzeug aus den ersten Satellitenpositionen und den 4 n 
ersten Pseudoabstanden; 

d) Auswahlen einer zweiten Vielzahl von Satelliten aus der Konstellation; 

e) Berechnen fur jeden Satelliten in der zweiten Vielzahl von Satelliten einer zweiten Satellitenoosition 
und eines zweiten Pseudoabstands; v 

f) Berechnen aus den zweiten Pseudoabstanden, den zweiten Satellitenpositionen und der Positionsab- « 
schatzung ernes ersten Fehlerkoeffizienten, der die Positionsfehlertrends in einer x-Richtung der 
Positionsabschatzung charakterisiert, eines zweiten Fehlerkoeffizienten, der die Positionsfehlertrends 

in einer y-Richtung der Positionsabschatzung charakterisiert und eines dritten Fehlerkoeffizienten der 
die Positionsfehlertrends in einer z-Richtung der Positionsabschatzung charakterisiert und 

g) Benutzen der Fehlerkoeffizienten, urn die Positionsabschatzung fur das Fahrzeug zu verfeinern eine ™ 
verfeinerte Positionsabschatzung zu produzieren. ' 9 

8. Das Verfahren nach Anspruch 7, das weiter einen Schritt vor dem Schritt (g) aufweist- 

h^Berechnen aus den zweiten Pseudoabstanden, den zweiten Satellitenpositionen und der Positionsab- 
schatzung eines vierten Fehlerkoeffizienten, der Fehlertrends in den zweiten Pseudoabstanden charak- 
terisiert. 

9. Das Verfahren nach Anspruch 8, wobei die erste Vielzahl von Satelliten den ersten, zweiten, dritten und * 
sSelSen\ufwd n st a W *"* ^ ***** ™" Satellitep den dritten ' vierten ? fQnften und sechsten 

10. Das Verfahren nach Anspruch 8, das weiter die Schritte umfaBt: 

scMtzung 16 " e ' ner DifferenZ zwischen der Positionsabschatzung und der verfeinerten Positionsab- , 60 
j) Vergleichen der Differenz mit einer vorherbestimmten Schwelle; und 

k) falls die Differenz grQBer als die vorherbestimmte Schwelle ist, Ersetzen der verfeinerten Positions- 
abschatzung durch die Positionsabschatzung und Wiederholen der Schritte (d)-(k) 
ii; E M S ^ e H ahr Tf n H f0 K einer Positionsabschatzung fur einen Empfanger, der sich auf oder in 65 

der Nahe der Erdoberfiache befmdet unter Benutzung eines satellitengestutzten Navigationssystems das 
e.ne Konstellation von Navigationssateliiten besitzt, wobei das Verfahren folgende Schritte aXeist 
a) Empfangen von mindestens vier Satelliten eines ersten Navigationssignals zum Empfanger; ' 
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b) Berechnen au^^R ersten Navigationssignal, eines ersten Pseudoabs^^R und einer ersten Satelli- 
tenposition ftir jedes der mindestens vier Satelliten; 

c) Bewegen des Empfangers von der ersten Position zu einer zweiten Position, wobei die zweite 
Position mit der ersten Position durch eine Geschwindigkeit des Fahrzeugs und eine Reise- oder 
Fahrzeit zwischen den ersten und zweiten Positionen in Verbindung steht; 

d) Empfangen von jedem der mindestens vier Satelliten eines zweiten Navigationssignals an dem 
Empf anger, der sich an der zweiten Position befindet; 

e) Berechnen aus dem zweiten Navigationssignal eines zweiten Pseudoabstands und einer zweiten 
Satellitenposition f Or j eden der mindestens vier Satelliten ; 

f) AuswShlen einer der ersten und zweiten Positionen ftir die Berechnung einer Empfangerpositionsab- 
schStzung; 

g) Berechnen eines ersten Fehlerkoeffizienten, der einen Fehler in einer x-Richtung fur die Empfanger- 
positionsabschatzung darstellt aus den ersten und zweiten Pseudoabstanden, den ersten und zweiten 
Satellitenpositionen und der Fahrzeuggeschwindigkeit und der Reisezeit; 

h) Berechnen eines zweiten Fehlerkoeffizienten, der einen Fehler in einer y-Richtung fur die Empfan- 
gerpositionsabschatzung darstellt aus den ersten und zweiten Pseudoabstanden, den ersten und zwei- 
ten Satellitenpositionen, der Fahrzeuggeschwindigkeit und der Reisezeit; 

i) Berechnen eines dritten Fehlerkoeffizienten, der einen Fehler in einer z-Richtung ftir die Empfanger- 
positionsabschatzung darstellt aus den ersten und zweiten Pseudoabstanden, den ersten und zweiten 
Satellitenpositionen, der Fahrzeuggeschwindigkeit und der Reisezeit; und 

j) Berechnen einer prazisen Empfangerpositionsabschatzung fUr die ausgewahlte Position des Empfan- 
gers unter Benutzung der ersten Pseudabstande der ersten Satellitenposition und den Fehlerkoeffizien- 
ten. 

1 2. Das Verfahren nach Anspruch 1 1 , das weiter einen Schritt vor dem Schritt (j) aufweist: 

k) Berechnen eines vierten Fehlerkoeffizienten, der einen mittleren Fehler in den ersten und zweiten 
Pseudoabstanden darstellt, aus den ersten und zweiten Pseudoabstanden, den ersten und zweiten 
Satellitenpositionen, der Fahrzeuggeschwindigkeit und der Reisezeit 
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